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NOMENCLATURE 


On 


Rolatjon uf join-i wiih re&PEct to Z axi%. 

n-i 


^pn 

Hn, Lny Rn 


Angle made by the n^*^ link wjth the horizontal 
Mass, length and radius of linl-. . 


Transformation matrix between and i*'*' 


frames. 

CTrans (a, b, c) 3 Translation by ''a-' along •'X-' axis, •'b' along 

''Y'' axis and 'c' along •'Z"' axis. 

Rot(axisi,01 Rotation of any linl.: by an angle '©■' about the 

axis 'axisi''. 




Moment of inertia of the i*'*^ link about its own 




* >r axis. 


Moment of inertia of the i*"*^ link about its own 



Krv 

Q 

(O 

con 

? 

Co, Cl 

Sp 


•' y •' axis. 

t h 

Moment of inertia of the 3 link about its own 
•'z' axis. 

th 

Joint stiffness of n link. 

Generalized force. 

Frequency of forcing function, 
natural frequency of the system. 

Damping factor. 

Damping parameters. 

Spectral density of excitation. 
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ABSTRACT 

The stability and response of the end effector of a 
2JD.0.F as well as five and six D.O.F manipulators subject to base 
excitation is investigated. The man ipulator s consist of rigid 


links that 

are connected 

end-to-end in an 

open 

chain. 

The 

connect ions 

between the base 

and the first link 

and 

between 

two 


successive links are characterized by resilient joints. Due to 
this compliance in its joints, the manipulator undergoes 
oscillatory motions when perturbed from its equilibrium 
configuration. The end effector is assumed to carry a load at its 
free extremity. When the intensity of this load reaches some 
critical value, the manipulator becomes unstable by divergence. 
The numerical values of the critical divergence load for various 
configurations of the manipulator are computed. The weakest 
configuration of the manipulator when the critical divergence load 
is the minimum is also found out. The behavior of the response of 
the end effector subject to deterministic and probabilistic 
excitations have been investigated. Finally, a comparison has been 
made amongst different D.O.F manipulators when a white noise of 
constant spectral density acts at the bases. 
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CHAPTER 1 

INTRODUCTION 


1 . 1 Preface 

Robot, in general, is an automatic, reprogrammable, 

mu 1 1 i f unct 1 ona 1 ,mechan i ca 1 manipulator. Ideally, without any human 
intervention, it can work independently using its own 

machine intelligence. It works more precisely than human being 
with higher repeatability and virtually no exhaustion. It can 
perform tasks such as assembly of electrical, electronics and 
mechanical parts eg. PCS, miniature ball bearings etc., peg-hole 
insertion, telechiric operations, welding of micro parts, spray 
paintings etc.. All these operations require accuracy of the order 
of 0.1 to 0.01 mm. Hence the precision of such type of robots is 
of utmost importance . 

One of the main areas of robotic development today 

concentrates itself on the control of positional accuracy. The 

controller of a robot regulates the mechanical positioning of 
'the end effector within the least amount of 'inaccuracy. This 
inaccuracy is not completely avoidable and is caused primarily 
due to joint compliance, link flexibility and incapability of the 

I 

controller to operate upon data extending to several places of 
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decimals. In recent times, there is a tendency to develop light 
weight robots which have the obvious advantage of lower space 
requirements, greater mobility and higher ofaerating speed. For 
example, CANADA-ARM which is used in space for retrieving 
artificial satellites for repairs and then putting them back into 
the parking orbit, is a light-weight long flexible telechitic 
robot. This structure has compliance in joints and links due to 
the reduction. in cross-sections. Nh i 1 e in operation, it undergoes 
some mot i on- i nduced vibrations which has to be damped out as 
quickly as possible so that the end effector can perform its tasks 
iwith less inaccuracy. When the mass of the load exceeds the mass 
of the manipulator, the elasticity in the links can become of 
considerable importance, as has been reported by Sunada and 

Dubowsky Cl]. Moreover, if the environment in which the robot 

works IS not free from vibration coming from other machineries, 
or in the case of mobile robots, where floor surface is not devoid 
of roughness and undulations, the positional inaccuracy can go up. 
Hence, a thorough understanding and quantitative analysis of the 
response characteristics of the end effector tip of the 
manipulator is required . 

1.2 FACTORS AFFECTING ACCURACY 

The positioning accuracy and repeatability of a robot depends 
on some factors such as CIO] given below. 

1> The force of gravity acting on the arm members and load of the 

robot causes downward deflection of the arm and the support 
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systeriu Thi& is referred to as joint and link flexibility . 

2> Acceleration forces may act in various directions. Noticeable 
horizontal and vertical deflections occur when heavy loads are 
accelerated . 

3'=-Drive gears and belt drives often have noticeable amount of 
slack that can cause positioning errors. 

4> Thermal effects can expand or contract the links of the robot. 
In large robots, this effect can be of considerable 
magnitude. 

5; Bearing "PLAY" can be significant when very high 
positioning accuracies are required . 

S' Low resolution of the control ler , in some cases may 
also be responsible for poor accuracy. 

6> The feedback errors arising out of malfunctioning of sensors 
can play a vital role . 

It is to be observed that some of the above factors may not 
have any role to affect repeatabi 1 ity because the inaccuracy 
in such cases may be repeatable . 

1.3 LITERATURE REVIEW 

The vibration in a moving flexible Robot arm was considered 
by Wang et al C 1 1. They have shown how the extension and 
contraction motions have destabilizing and stabilizing effects on 


the vibratory motion respectively 


The vibration analysis was 
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based on Galerkin approximation with time dependent basis 
function. The study restricted its consideration to the bending 
vibration of the Robot arm in one plane only. 

Meghdhari and Shahinpoor C33 presented a complete 
derivation of the combined f 1 exura 1 - j o i nt stiffness matrix and 
the elastic deformation field of a flexible manipulator. The 
stiffness properties were derived directly from the differential 
equations used in engineering beam theory. The elasticity of the 
joint was modelled by considering the robotic links attached 
end-to-end with the help of flexible connector. 

Hill and Vaccaro C4] treated a robotic manipulator 
with joint compliance to make an on-line scheme for computing the 
inverse joint solution with non-linear feedback control in joint 
space . The study used the recursive formulation scheme for 
calculation of all the elements in the dynamic equation and 
considered the vibration effect on the feedback loop. It neglected 
the existence of Coulomb friction and gear backlash in the joints. 
'Hence, some error is introduced due to the absence of non-linear 
contribution from these terms. 


S i ra-Rami rez 

et 

al C5] studied the robust 

cont ro 1 

of 

robotic manipulator 

with flexible joints. 

They 

mode 1 1 ed 

/ 

the 

flexibility in 

the 

joint by incorporating 

the 

concept 

of 

” f 1 ct i t i ous 1 ink” 

which would take care of 

the 

comp 1 i ance 

by 



6 


converting an ''n' D.O.F manipulator to a corresponding 
'2r\' D.O.F manipulator. 

The compliance of a structure varies with the weight it 
possesses. The lesser weight of a manipulator makes it more 
vibration-prone as the joint compliance starts taking vital role. 
In this respect, the vibratory characteristics of an unloaded 
industrial Robot with rigid links and resilient joints have been 
highlighted by Sunada et al C51. 

Ziegler C63, Bungay et al C73 reported that certain 
classes of mechanical systems when subjected to non -conser vat i ve 
forces might execute different types of motions like small 
oscillation, flutter and divergence when disturbed from an 

equilibrium state. They dealt with mathematical models based on 
rigid links and resilient Joints in an initially straight line 
conf igurat ion. 

The above work was followed and improved by Anderson 
C83. He investigated the stability of a manipulator subjected to 
a non -conser vat ive force applied at the free extremity. It 
includes the different modes of failure of the structure by 
instability and the computation of the numerical values of 
the critical divergence and flutter loads for various 

configurations of the manipulator. They did not consider 

frictional damping in the joints. By considering a 3_D.0.F planar 



manipulator, it lost the generality of spatial motion of a 
pract i ca 1 -purpose robot. 

1.4 PRESENT WORK 

The present work attempts to model the robot with the base 
affected by - 

a> Deterministic excitation 
b> Random( Stochast i c ) excitation 

I 

The positional inaccuracies induced due to the vibration 
transmitted to the end effector have been examined for a simple 
two D.O.F as well as five and six D.O.F robots separately. A/ small 
amount of damping that can play the role of controlling response 
at all values of frequency ratio is included in the analysis. To 
make it more general, the work has been extended considering 
PUMA_560 which has six non-redundant links. It also includes the 
study of the behavior of the manipulator under a constant load at 
the tip and assorted excitations at the base by giving sinusoidal, 
square and random input. By all these, a prediction can reasonably 
be made about the response characteristics of the manipulator 
when subjected to other general types of dynamic loads. The 
critical divergence load i.e the load under which one or more 
natural frequencies cease, bringing about instability in the 
system is examined at different geometric configurations of the 
structure. Also its variation with the load at the tip and with 
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different configurations are plotted to draw a general 
conclusion about the features of the system at some specific 
values of joint parameters of the structure. Finally, a comparison 
of response has been made amongst different D.O.F manipulators 
for random input excitation . 



CHAPTER 2 
MODELLING 
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2 . 1 ASSUMPTIONS 

We have modeiied a simple 2_D.0.F manipulator as well as 
five and six D.O.F manipulators separately with flexible joints. 
The links are connected end to end through revolute joints. The 
link connecting actuator to the arm undergoes re tive rotation 
With respect to its two ends. This flexibility at the joint is 
modeiied by linear tirsionai spring with ‘;pring constant *K*. 



FIG.2.1 ELASTIC JOINT. 

The model js based on these assumptions . 

1> The links art totally rigid except the compliance at the 
joints. 

Z> The links are cylindrical and axisymmetnc . 

5> The mass density of the links are uniform . 

4> The joints may undergo small oscillations . 

5> The motion of the manipulator about the equilibrium 
configuration is very slow. The same assumption was followed by 


AndersonCB 3 . 



2.2 LINK CO-ORDINATE SYSTEM ASSI6NMENT 


JO 

For the study of response, it is always convenient to 
set up individual co-ordinate frames to each link. Each frame will 
be related to the non-inertial base frame by lini'. and joint 
parameters. To set up the co-ordinate frames, Denavi t -Har tenber g 
convention C is followed as given below. 

With reference to Fig. 3 , it can be written 

Ih 

1- The Z axis lies along the axis of motion of the n joint. 

r»-l 

2> The X axis is normal to the 2 axis and pointing away 

n TV-1 

from it in the direction of the common normal of z and 2 

n — 1 n 

axes. 

3;- The y axis completes the right handed co-ordinate system as 
n 

required. 

By this, one is free to choose the location of 
zero*"^ co-ordinate frame anywhere in the supporting base, as long 
as the X axis is normal to the z axis . 

n n 

2.3 TRANSFORMATION MATRIX 

Let the transformation matrix between the i and the (i-1) 
frames be given by sin(©n), cos(©n) are denoted by 

Sn, Cn and sin(^J, cos(^) by Sm, Cm respectively where 
m = 2,3,6 and n = 1,4,5. 



Thus, 


^ ” Trans 1^0, 0, Zb j = 


0 0 


[ ^ (Z. ©i) j- j^Trans (O. 0, Li] j^ROT [Y, 90*] j^ROT [Z , IBO*) j 


0 Si Cl o 

0 -Cl Si o 

1 0 0 Li 

0 0 0 1 


ro Si Cl 


[ ^] = [ ^]•[ M = : 


0 -Cl Si 


0 0 


(Li + Zb) 


>{isi,0ij| denotes the rotat ion about any axis axisi' 


Where, |rOT (ax isi, ©i) j denotes the rotation about any axis axisi' 
by an angle ©i and jrrans (x, y, z) j denotes a translation of x along 


X axis. 


along Y axis and 


along 


Z axis 


^ [rot (Z,© 2 )j* jTransfL2,0,0)j = 


C2 -S2 0 L2*C2 

S2 C2 0 L2*S2 

0 0 10 
0 0 0 1 


[ “ [ *"•]*[ ‘■'J 


Now putting 9z = (S 2 - U/Z) where *2 is the angle made by the 



lin^ with 

the horizontal, we get 




■-Sl*C2 

S2»Cl 

Cl -L2*S1*C2 

r ■ 1 


-Ci*C2 

-S2*Cl 

Si L2*C1*C2 

^2 

== 




L *J 


S2 

C2 

0 (Li + L2*S2 



0 

0 

0 1 

[ ' 

ROT (2 

; ^ ^8-^2 

)j*|^ROT(X, -90 

•)]*[r0T(Y,90‘3] 

\ "t.1 = 1 


M 



L »J 1 

L *J 

L 




— Si*Sa -Ci 

Ci^>-Sa -Si 


-Ca 

0 


0 

0 


-Si*Ca (-L2*S1*C2) 

Cl*C8 (L2 *Ci*C2.) 

Sa (Li + L2»S2 + Zb) 

0 1 


[Z,©*)J*[Tran5(0,0,La+L4)j*|R0T[X,90’3j 

[M •[■'.]■[ M 
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i*Sa*C4+Ci*54j 

-[5i*Ca] 

[-Ri*Sa*54+Ci»n4 ] 

[Sa»Ci»C4-5i*54] 

[Ci«Ca] 

[Sa*54«Ci+S4*r4 ] 

[-Ca*C4] 

] 

[-S4*Ca] 

[0] 

[0] 

[0] 



-5i*j^ n_a+L *)»Ca +L2»C2 



r.i» [f La+L4'j»Ca + L 2 «C 2 ] 


[(La+L4)*5a+Li-+L2*S2+-ZB] 





Cs 0 -Ss 0 
Ss 0 C5 0 

0-3 0 0 

0 0 0 1 _ 



[ = [ M-[ ^] = 

— [(Si*S»*C4+Ci*S4) •C» + S4«s»*c»] |S**S8*S4 - Ci*C4 ] 

[(S»«Ci*C4-Si«S4)4Cs + S»*C4«C»] -[S4»S»*C* - Si*C4 ] 
[-C»*C»*C4+Ss*S»] [S4*C8] 

[ 0 ] [ 0 ] 

[(S**Sa*C4+C4»S4)*Ss-S*«Cs*C8] [-Si*l(L8+L4)4C8+L2*Ca}] 

[-(S8*C4*C4-S44S4)*S»+C»4C4*C8] [C 1 * £ ( L8+L4 ) ♦C8+La*Ca }] 
[Ss*Ca*C4 + S8*C5 ] [(L8+L4)*S8+Li+La*Sa+Z»] 

^ [0] C 1] 

This chapter has dealt with transf ortnat ion matrices relating 
different link co-ordinate frames with that of the base. Thus the 
potential energy and kinetic energy of the system which is nothing 
but the summation of the same of the individual links, can be 


found out with great ease in the next chapters 3 and A. 
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CHAPTER 3 , 

DYNAMICAL EQUATIONS OF A TWO DEGREE OF FREEDOM MANIPULATOR 

Before going to the comp le>:i t y of a 6_D.Q.F robot, let 
us tale the case of a 2_D.0.F robot and analyze it to get an 
insight into the problem. In order to find the equations of 
motion, the potential and the Finetic energy of the system at any 
arbitrary configuration is desired. 

3.1: KINETIC ENERGY (KEl CALCULATION 
A> KE OF THE FIRST LINK 

With reference to Fig. 2.1, it can be shown that 


Y«Si + 7»Ci 




-Y*Ci + Z*Si 

-X + Li + Zb 
1 


where, 

-X Y Z ]J, denoting the position 
vector of any point on linki with respect to the 1*'' co-ordinate 
frame . 

By differentiating, we get 

« 

(Y*ci - zs*^Si)*ei‘ 

M t 

CY*Si +• Z»Ci)»©i 

Zb 

0 

Let KEi denote the kinetic energy of link 1. 

"2 

KEi 

ml 
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Where, 

|^*Vel^j3s the velocity of the first lini-- with respect 


the base frame. 
Now, 


f *Vel 1 = 

" B - ’ 


Tb ■ 

. 2 



P 



= ie±> • 

Y + Z 


1 


p 


1 




1 


L J 


«. • 






Therefore, 


KEi = 


2 2 .2 .2 

0.5*>|<Y + Z >*(.e±'> + <Zb) |*dm 


■K' 


)■ 


* » 2 tt 2 

Where, 

Ji is the polar nioment of inertia of the J**" linh- 
B'.- KINETIC ENERGY OF THE SECOND LINK? 

The position vector of any point on link 2 in the base frame is 

X«Si*C2 + Y«S4*S2 + 7*Ci - Li«Si*C2 
Z»Si - X*C*«C2 - Y»S2 »Ci. + L2*C2»Ci 


1 -'Jt-.] ■ f '.] 


Y«C2 - X*S2 + Li + L2*S2 + Zb 


where , 


[■ "• ]■ 


L 


-X 

Y 

Z 

i 


to 
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Now , 

KEz =■ *'^^^ 2 ) * 

m2 


Where , 

|®Vel^jiSv the velocity of the second link with respect 
to the base frame. 


B 

. 2 

'2 2 2 

2' 

2 X 2 m Z 

Vel 

= (0i)» 

I • ( S 2 ) + 

I *^C 2 ^ 

+ T (Zb.> ♦m2 

2 


XX 

. 

yy 

z z 


mm 2 mm 

- (01 >* (§2)*C2*M2*L2*0, 5 + (52)*f 7B)*il2*m2«l.2 

2 

Here, I is the moment of inertia of the secono link with 

XK 

2 

respect to the X 2 axis and I is the same with respect to the Y 2 

yy 

axis. 

3.2 rPOTENTJAL ENERGY ( PE > CALCULATION 

The potential energy of any lini-' would cons i si 

of two parts. One would be coming from the conservative forces due 

to gravity and the other would be from spring force due to 

joint compliance , As the n^'^joint is rotated through an angle 

a restoring moment of kn**r> is* induced in the joint. This is 

contributing to increase in P.F.of the system. The potential 

energy of the system(PE*y«) can be written as the summation of the 

potential energies of the first and the second links, 

PE«y* = PEi + PE2 

= Mi*g*(0. 5*l_i + Zb> + M2*(Li + Zb + 0,5*L2»32)*g 

2 2 

+ 0-5»K2«(^ - + O.5«Ki*(0i - 040) 



1 « 


Whpre and ©lo are the equiljhrjum angle?- of linl* 

and linki respectively. K* and K* denote ihe rotational sliffne??; 

of the respective joints. 

3.3 LAGRAMSr'P i:OUATION 

Lagraiiye & equation in ternis c»f generalised force and 
co-ordinate is 



Where , 

L is called the Lagrangean and L= fKE»y« - PF»y»i 

qk and Qk are the generalised co-ordinate and force respectively. 

3.4 CALCULATION OF GCNFRAl TBLD FORFFS 

Let us choose Zb , 0ir and ^ to be the generalised 

co-or d inates. The corresponding genpralised forces are Qb, Qi and 

Q*r When there is a virtual displacement in the system from 

the equilibrium configuration, the virtual work done(vwd) is 
given by 

VWD = (Ui - Tfi.>»d©i + (Ua - Tf*.l»d^ + p.rl^p 

Where is the position vector of the end efector tip 
with respect to the base frame and Ui, Uz are tlie joint 
torques of the respective joints. Tfi and Tfz are the frictional 
torques at the joints . 

A A A 

Rp = -L*»C*»St«j + La*Ca*C4*j +(Lji + La*S2 + ZB)*k 
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Where i , j , I- are the unit vectors along X»,Y»,2» axis. 

Now r P =• -P*K 
Hence , 

?.cl^p = “P*L2*C2»d^ - P*dZ» 

VWD - iK}± - Tf4)*d©i + fU2 - Tf2 - P*l.2»C^)*d<^ - P*Zb 
S o, the generalised forces are ; 

Qi - Ui - Tfi 

Q2 = U2 - Tf2 - P*L2<C2 

Qb = -P 

3,5 POUATION OF MOTION 

In order to find the equation of mot ion,La 9 r ange s 
equation is used for each of the generalised co-ordinates .Taking 
Qi and ©i as the generalisea force and co-ordinate r e«.pect i ve i y , 
after going through some mathematical operations, we get. 

Ui = 0 . 3.2 

Similarly, taking Q 2 and the corresponding equation is 

m » j . 

^ 2»*1 ^ + ^Zb*M 2 *L 2 *C 2 + K 2 »<;^ - <fax>) + i*M 2 *L 2 *g*C 2 

SSSE i#* 

= U2 - P«L2*C2 - Tf2 . 3 . 3 ! 

Taking Qb and Zb, 

mm t* it it 

(Ml + M2)ZB + 0..5*M2«L2*C2*^2 - 0. 5*l'l2*L2*B2*(^2)* 

+ (Ml + M2l*g - -P . . . ........3.4 

The first of these equations shows that the 
external torque to be applied in the first joint is sero 


because there is no disturbing couple in the axial direction of 
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fhe first link . 

The second equation is actually the vibration equation ia! inq 
care of the spring , damping and eitternal forces. 

The third one is coiriing from the dynarfsic equ i 3 i hr i urfi of the 
struc i'ure by considering the force balance in the vertical 
direc 1 1 on. 

3-6 SIMPLIFICATION 

In this section, some simc'lifying assumipt i ons have l:>een rnaoe; 
that will permit the reduction of the corripiexity of the 
differential equation 3.3 . Ti is assumeci that the system 1= in a 
state of equilibrium when ^ and ©1= ©10 with Uk- s denoting 

the torques applied at the joints. 

At equilibrium configuration, equation 13 . 3 J reduces to 
M2«L2»g«^C2O*0 . 5 =■ U2 - P*L2*C20 

Now, as mentioned earlier, the motion of the manipulator being 
small about the equilibrium configuration, one can write 

+ ^kCi), where } <^k j < '. I 

In particular, it is assiurted that one can make the approximation 
cos(^k) = 1 
sin(flhck) = ^k 

Therefore, 

#•«# 

sin(^> = sin(^o) + ^k*cos(^o) 
analogously, 

cosC^l = cosi^o) - ^kk*sin(^o) 
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The terms like ^k*7» are agnoredr 

By using ihesp simplifying assumplionsy it can be writien, 

St m m m 

+ C 2 d *^22 + jj K 2 - CM2*g*0.5 + P ) ♦L2*S20 j *^2 

_ - M2»1_2*C20*Zb 

— — JT 

«2 + 2*K*^ar^*4az + <£n^»<pzz = — 3. B 

2 

2* I 


Where r 


2 


<A>n 


K2 - f M2*g^0 .5 ’4"P ) *l.^2*S2 



zz 


^ r= y Qaa being the damping co-ef f i c 3 ent . 

2**1 *C0n 
zz 

3,7 DETERHINTSTTC EXCITATION 

3.7.1 r SINUSOIDAL EXCITATION 

Lei sinusoidal excitation arts at ihe base of the manipulator 

and is given by Z» = Zo*sinCw»t), where Zo is the amplitude and w 

IS the frequency oF the forced excitation . 

Hence, equation 3 . 5 . can be written as 

mm m 

2 

^22 + 2 »?» ft > r »*^2 + o>n «^^22 = V*sin .................... 3. 6 

Where V = M 2 *L 2 *C 2 *Zo*«*/ (.2**I ) 

ZZ 

The above equation 3.6 has to be solved for the transient as well 
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as steady state. 

The three transient solutions aepenci upon the value of 


CASE 1; ? > 1 


^ 2 /. = e 

/ iroino 


■( clcay*t ) 


[C4*e 


( d f q*t 1 


+ C2»H 


-(dfq»t) 


CASE 2: ? ' 1 

^*/trar>« ~ ^ ^ [Ci*c:os (df q*t ) + C 2 »si n f df q*t > ]| 


CASE 3! ?==! 

^/trem. " + C2*t > •e " 

The particular integral is 

PI = A*sin(<<>»t + 

Where, A =V/Jy/(l - (w/wnl*)* + (2*?*o>/wn)* 
4 > =tan ^ -1 


Hence the complete solution is 

^22 = ^2 , + P I . 

/troins 

As the response of the second jojnt is known , the resp^onse of 
the end effector can be • found out with respect to the base 
co-ordinate frame . The vibrations in the XBrYBrZs directions are 
given by 

Ei = - L2*S40*S20*^22 
Ej = L2*C*0*S20*^ 
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Ek = L2»C20*^22 + Zb 

3.7.2 SQUARE IMPULSE EXE T TAT I ON 

A square impuise excitation at the ba%e having an air»p 1 1 (■ ucle of Zo-' 
and period ^tt-' is assumed to act at the base of the robot. 
The pulse can be represented with the he]p of Fourier series as 
f ol lows: - 


Zb •=• Zav + 

oc 

2*Zo T 1 . 

IT 2"^”’ 

n=i 

Tl*n«ti 

*cos 

'n«t i»n 

2n*n*t 

•B 


. 

tt 

1 1 

.1 

the 

solution of 

equation 3-5 

w j i h 

squar e 

1 1 


3.7 


above type is given by 

a 




r AMPn pn^n** 1 

) • sin + LAGn 

^ Wn L tt J 


Where , 


. IS same as before . 

/ 1 rOTMl 


n n«n*t4 ^ . -3 p»Z*(wfn/con) Jf, ^ , ,2 

and LAGn =15 - — + Ian I ^ /(^(tofn/wn) ”IJ I 

Where, «fn = 2n*n/tt 

The response of the end effector can be found using the same 
expressions as in the case of sinusoidal excitations . 

3.8 : RANDOM EXCITATION 
3.8.1 : ASSUMPTIONS 

Let us now consider random excitation at the base of the 
manipulator . Any random process can be char acter 1 red by the 
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probability density and distribution functions such that spectral 
density , auto-cory e] at i on function , rrisan squai e value etc. The 
most general type of random excitation is too complex but 

some of the randoni processes have been studied extensively in 
literature Cl3 — 15 ;i with respect to vibration problems. 
The random process under consideration is based on some 
assumptions. These are 

!• The random process is ergodic ano stationary . 

2.1 It follows baussian distribution . 

3.5 The spec + ral density of excitation is constant over feasible 
range of frequency . 

3.8.2 COMPLEX Rrai'PTANCE 

Let the spectral density of excitation be denoted by Sp .In 
order to find the spectrai density of response at the tip, the 
corTiP lexreceptance of the system is to be found out. Lei li be 
denotedby «fi«). Hence, for a load of Zb = Zo^e^*^*" , with the help 
of equation. 3. 5 the response of the second joint can be written as 
^22 = oc( ia>.l*Zo*e . 



Where 
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^ Ma*L**C20*c«>** < 1 - Fr*) 

<Xr= 

Fr , the frequency ratio =• - 

b>n 

and, 

M2*L 2 *0 20*Ci>* *2«? •F r 

OCX TO* 

3.8,3 .• SPECTRAL DENSITY OF THE RESPONSE 

After the coinplex receptance of the system is known, the 
spectral density of the response can be related to that of 
excitation . 

The response of the end effectcir in the vertical direction for 
any Zb is given by , 

Ek = L2»C2*^2 + Zb 

= [L2*C2*oc( iw) + l]]*Zo*e'’**^ 

Ek -• Ekf.iw)*Zo»e’'‘^ 

= (Ekr - i^Ekxfn) •Zo*e'^ 

Where , 

Ekr = 1 + L 2 *C 20 *o<r 

and 

Ekim * L2*C2O*0 &.to 

Hence, 




jEk(i<«>)|* = Ekr* + Ekim* 
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Simiiarlyr for the y component of ree«pon=>e 

|Ej(ltA>) I = ^Ejr) + lEjim)* 

Ejr = - L2*S2 «Ci*<» 

Ejim = - Lz^Sa^Ci^oelTn 
And finaJJ. y for the X -component, 

lEifj.«)|*= tEir)* + (Evvtr,^® 

Eir » La^Sa^Si*©*- 
Enm = i_2»S2*Sl*<Xi,n) 

The spectra] clensji'y of r espcmse in any direction n ' rriay be 
expressed as 

Sn(<«>) ~ |En( iw> j^^SpCco] 

3,8,4 MEAN SQUARE VALUE OF THE RESPONSE 

The mean square value of the response of the end effector can 
be found by the following jntegral- 
1 ^ 

<En®(t)> = [Entiw) |»Sp*dco 

o 

c 2 

fEn®(t)> = |En<lw)[*d« 

The above integral of the mean square value c:an be 
calculated with the help of Residue Theory or by any standard 
procedure of numerical integration 

For a linear system ,if the input excitation follows Baussian 
distribution ,the response will also follow the s»ame distribution 
ClSJ . 


As the systeni under consideration is linear 


by making use of 
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tliA'i' proper! 

wr X te , P (Et>! 


y, after assuming I'ero mean of the r 


1 - _-En*/2o-n* 

■ aJSTTzsnr ® 

2 2 

Where, cm - -'Entti ' and js called 


esponse one 


the variance. 


can 


3.9 SUMMARY 

This chapter has described the position of the end effector 
of a 2_D.0.F robot at any joint conf xguration. Thus the deviation 
of the end effector from a particular desired position can be 
obtained at any instant of time. The behavior of the response of 
the end effector at various frequencies and spectral density is 


shown in chapter 5 
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CHAPTER 4 

DYNAMICAL EQUATIONS OF MULTI-DEGREE-FREEDOM MANIPULATORS 

4.1 5_D.0.F SYSTEM 

4.1.1 ! K.E AND P.E CALCULATION 

Following the same procedure as depicted in chapter 3, one can 
arrive at the expressions of the K.E and P.E of the and 

the 5^^ links as follows 

1 ni*^i ■3l» 

(K.E)* = + M»*L*»C**^2»Z» 

1 ■ ■ 1 ' “ 

+ ^M»*La*LB*cos(^2-^8)*^2*^ + ^M8*La*C8*Z»*^ 

1 * 

(P.E) 8 = ^K8*[]^ - ^80 + - ^ 2 ] 

+ [Li + Zb + L2»S2 *■ L^Saj|»M8*g 
(K.E)* = i*M**L2**(^2)*+ ^*1 *(^^) + 5•M*•(ZB)* 

2 2 yy * 2 

. . 1 . . 

+ M**L 2 *C 2 »« 2 *Zb + M*BL 2 * (La + }«C8 2 «S 2 «S 8 

+ M**fl^8 + ^^BCaB^BZa + I*q*(^)* 

Where, 

!•<* = 0.5»^I + 0.5*M4*(L8 +*)* - 0. 5*M**L4*(La + L*) 

ms 

a 

+ 0* l.?5»h4:rfL4 ♦s:in(204)* 
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(P.E)* = Zb + Li + L 2 *S 2 + (La + 0 . 5 *l_ 4 )*Sa ] 

+ O. 5 *K 4#*(04 - © 40 )* 

(K.E)» - 0. 5*M»*L2**(^2.)* + 0.5*rC»**®I + 1*(*4)' 

*- xz yy J 

+ 0- 5* nS4-o.S5)*«®I + f(S4:»-C5) ®+ C4*1*®I + M5*(La+L4>* 

»- ZZ V J VV- 




*sin ( 2 ^ 4 ) *Cat •<- M»»L»^(L» L 4 >*C 5 ]*(^»> + 


• (C5»C»z -Ss»C*«S 82 )+ Mo«Lz(La+L*)'*'C»al^*^a 


[s*.f 


mm m m -mm 

S4*Ss*Ca2*^2*^4 - (Ca2*C4*C5 - Sa2*S5)^2»^ J + 


re*.’! - 34 . 0 . 22 ?:^ 

L yy 4 2 


i^»C 4 *Csfj 


• * I BKXl'^aC " " 

4* — T — ^^♦^4*05 


+ r(C»^Cs ? ■■ 4 Mti^CLa + L 4 )♦Ca^<^fl^a♦Z» +M 5 *La♦C 2 ^^^^ 2 ^•^ZB 


+ — r(Ca"aC4aCg “ S9*S^)^(p9^ZB *“ S4'aS5*Caa^4^ZBl + 0. Zb) * 


(P.E)» =MBag* Zb+ Li +L2aS2 ^CLa -f L4)aSa + ~ ♦(S5*Ca^i^C4 -4- Sa»C») 


+ ^ •Ks*(©5 - ©50)* 


4.1.2 CALCULATION OF GENERALIZED FORCES 

Let the generalized co-ordinates are ©i, ©4, ©s, and 
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Zb. The corresponding generalized forces are Qi, Qa, Qa, 04, Qs and 
Qb. Using the same procedure as that of the 2_D.a.F robot, one can 
obtain the generalized forces for a 5-D.0.F-‘ system. 

Thus, 

Qi = Ui 

Q 2 = U 2 - Ua - P*L 2 *C ^2 

Qa = Ua - P*[(La + L4)*Ca - L5*Sa*SB*C4 + Ls*Ca*C» ] 

04 = U4 + P*Lo*S4«Ss*C:a 

Qa = Us - P*Ls* [Ca*C4*C5 - Sa^Ss] 

Qb = - P 

4.1.3 : EQUATION OF MOTION 

Applying Lagrange s equation for each of the independent 
co-ordinates, one can get the equation of motion of the 
system. Considering the equilibrium of the system at ^ = ^o, 

applying the standard technique for linearisation and neglecting 

mm m 

2 

the terms like and , the set of coupled linear 

equations obtained are given below. 


M41*^2+ 

Mi2*^aB+ 

M4a*^44+ 

M44»^S+ 

K 11*^22+ 

Ki2»^a+ 

Kia*^4 



+K 44*^5 = 

Pi 




m m 

M24*^22+ 

m m 

M22*^884’ 

m m 

M2a*^4+ 

m m 

M24*flh5S+ 

Kai^^a-^- 

K 22^^9a*+* 

K 28*^4 



+K24«^S5 * 

P2 



* M II II r It ^ 

m m 

Mai«^224- 

m m 

Ma2«^aa4- 

m m 

MbB*^44+ 

a « 

Ma4*^5+ 

Kai«^2+ 

Ka2*^a+ 

Kaa»^4 



+Ks4*^S5 = 

Pa. 



a », » » r a 4 

a m 

M4i*^22+ 

m m 

M42»^B+ 

a m 

M4a*^44- 

m m 

M 44*^5+ 

K 41*^2+ 

K42*^aa+ 

K 48*^4 
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+ K*4*^5 * P4 4.4 

We can write all these equations in matrix form as follows. 


[ 

M 

]['■ 

]* 

[ « 

][ 

x]. 

[^] 

where 

T 










Mil 

Mia 

Mia 

Mi4 


r 



Mai 

Maa 

Maa 

Ma4 


[ 

M 

]- 

Mai 

Maa 

Maa 

Ma4 





M41 

M4a 

M4a 

M44 





Kii 

Kia 

0 

0 





Kai 

Kaa 

Kaa 

Ka4 


[ 

K 

]' 

0 

Kaa 

Kaa 

Ka4 





0 

K«a 

K4a 

K44 





Im 


T 

■ 


[p ] 


[ Pi Pa Pa 

P4 

] 









T 


[\ 

]■ 

= [ ^ 



409 ] 


Pi 


, Ma 

V o 

+ Ma 

m ' 

+ M4 + Ms >*La*Cao»Zi 


- 4. 5 


Pa 


r ^ *^*^*-” + M4*C La + -M- > + Ms C «-a + L4 ) >*Cao 


+ ( Cao^Csjo *- Sbo*S50^C40 


M»*L55 


]. zl 


— C S40*Sto«C80 Zb 


P 4 = - ( C»o«C40<»Cbo - Sao*S90 >Zb 
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Mii = * Ms)*L**] 


Mia = M 2 i= Ms*La«Ls*(Cso*Ca 2 o - S5o»C4o»Sa2o) * 0. 5 + 

M5*L2*(L» + L4)*C»20 + -*y^***~* *Ca 20 + M4*L2*( La + ^)*C 820 


Mia = Mai= - 0 . 5*M5*L2*Ls*S40*Sso*Ca20 


Mi.4 = M41 — g- ^ ( Cg2o4C 40*Cgo - Sszo^Bso^ 

M 22 = *I + (S40*Sto)**®I +r(S40*CTO)* + C40*1*®I + Ms*CLa + L4)' 

** aca *- -* yy 

- M»*L9f*[(La + L4 )*Cw> - ^ •s.j n (2e4o)*CTO] + 2«l4q 


S4oaSso*C50*** I + Sso*C40* .i .!"** ' 


M5*L5 


«<La + L4>*S40*S50 


M24= M42= C40»*I - 5404 Cg0» '^?X^ — + 0 . 5*M5*Ls* ( L 8 +L 4 ) •C40*C!K> 

yy ^ 

Maa = + (Cto)***I + CSao)**®! 

yy ** yy 


Ma4 = 

M4a = 

1 1 

M 44 = 

*I 



yy 


Kii = 

Ka + 

Ka 

Kia = 

Kai = 

- 

Kia = 

Kai = 

0 


*S90 


= Ka + Ka - j^(0.5*M2 + Ma +• M4 + M5)*g + pj*La«e20 
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K14 

Kz2 


K*t = 0 


|^Q14.*(Lb + 0 .5»L4) + Ms*(La + L4))«g + P*<:L8 + L 4 )j*S 8 o 
|s90*C80«C40 + S9o*C5oJ*|p + j »Lg + Kb - — -J U Sao 


Kzb 

K24 

Kbb 


KS2 

K42 

K4 


S8c**S4o*sso* (p + 

-CS80*C40*C8(0 + S50*C80)»(P + 
C80*C40*S50* 


Ka4 = K49 = - Cao*S40*C50« (p + 

K44 = - < Cao«C4o»S50 + C»o*S8o)»(P + j »Ls + Ks 

4.1.4 FREE VIBRATION ANALYSIS 

Now let us concentrate on the free vibration analysis of the 
system to obtain a condition from which the system natural 
frequencies can be found out which would be of much help to know 
the behavior of the system when subjected to forced vibration. 


Let us assume that 




•f (t) 


1 

mdi 
md 2 
■ mdB- 

Hence by putting this in matrix equation46, we get 


Where 


r l^mdj 


+ 


4.6 


[ M ] [md]«f (t) 


[ k ] [md]»f <t) = [ 0 ] 
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T 

f(t) ~Cmd3CK3Cmd] * , 

-jTtT = 5 = 

fmdKMKmd] 

[-»*[ « ] + [K ]].[ md ] = CO] 


For non-trivial solution of CrndD , 




1 

-<4[ M ] + [ K 

] = COl 


■ [Ki* 


jK42 - <«>**M12] 

[- «**M4»] 

J[- < 0 ** 1 * 144 ] 



[kzi 


[k22 - ti>**M22] 

[kaa - 0 i>**ti 2 a] 

[k24 - < 0 ** 1 * 124 ] 



[- 

«**M84] 

[K 82 - <.>**Ma2] 

[Kaa - £.)**Maa] 

[Ka4 - < 0 * *Ma4] 


=0 

L C" 

&>**M4i] 

[K42 - («>**M*2] 

[K4a - a>**li4a] 

[k44 - < 0 ** 1 * 144 ] _ 




By expanding the 

above determinant, we 

get 


8-degree polynomial of the following type. 

A •(«)* + A + A ♦(<•>)* + A ♦(<•>)* + A = 0 y I 

Where A , k = o,Ar2r8,4 are constants to be obtained by 

k 

expanding the above deternanant • 

We call this equation as frequency equation. 

The solution of the frequency equation would give four pairs of 
roots that may be real, imaginary or complex. If the external 
load 'P^ at the tip is less than a critical value then the eight 
roots can be expressed as +<»>., j = 1,2, 3, 4, where « > 0. In 
such casSy ths rriotion of ths rrianipuiator is stabls* Thesa natural 
frequencies are functions of the equilibrium angles K = 2,3 



35 


and 9 ^^ ,K = 1,5 i.e, the natural frequencies of the manipulator 
depend upon its current geometric configuration. In the 
description of the numerical calculations that will be reported in 
chapter Cf 3 , indications will be given on how the values of 
vary with the equilibrium angles . 

4 . 1.5 ; MODAL ANALYSIS 

Now our aim is to find the modal vectors corresponding to each of 
the natural frequencies in a bid to find the mode shapes and 
later on to obtain the modal matrix which would help enormously to 
decouple the coupled set of equations Ceqn.4.1— 4.4 3 obtained so 
far. Now, going back to equation, for any o>, we can write 
(Kii - mdi*<.K« - t«^M«)+ md2»( 

+ mda^t-co^Mi* ^ -*• OiiaKaifaKaitv 


(K21 - c« 3 ri 24 )+ mdi*(K22 - <«)8 m 22)+ md2*(K2a - <oiM2a) 

+ md8«(K24 - Ci>tM2*) = 0 4.9 

( -wiriai.) + mdii*(Ka2 - (iAia2)+ mda»(.Kaa - w^Maa) 

+ mda*(Ka* -ci^Ma*! = 0 4.10 

( -a^li44) + mdi*(K 42 - («^M 42 )+ rrid2*(K4a - aJ^ti4a) 

+ mda*(K44 -<o5m44) = 0 .. 4.11 


Out of these four equations only three are independent and 
the rest is dependent on these three. This is not at all 
surprising because at the time of finding the eigen value 
solution the corresponding determinant was conditionally assumed 


to be zero. 
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So one can now solve any three equations to find the 
modal vectors corresponding to all natural frequencies . 

Thus the modal matrix can be written as. 



‘1 

1 

1 

1 


md 2 i 

md 22 

md 2 a 

md24 

MODE ]= 

mdsi 

mds 2 

mdss 

md84 


mdai 

md42 

md48 

md44 


4.1.6 INCLUSION OF DAMPING: 

Let us now incorporate damping in the system. If the damping 
matrix be denoted by Cel, the original matrix equation -4.5 can 
be modified as 

CMirxi + CcHXl + CKICXI = CPI 4.12 

To choose a suitable damping matrix for a particular system 
with reasonable accuracy, is a highly controversial and 
questionable issue. Because the only way to get a suitable damping 
matrix is to perform an experiment with the system under 
consideration, simulating accurately the operating atmosphere of 
the system and then to evaluate the elements of the damping matrix 
by proper analysis of the experimental result. Now the first 
bottleneck that one has to overcome in doing so is to simulate the 
actual situation in the laboratory which, in most of the cases, is 
very difficult, if not impossible. The second difficulty lies in 
measuring all the required experimental result with the level of 
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accuracy desired. Moreover, even if the exper imental results 
are available, the effort required in performing so hardly 
satisfies the reliability aspect of it. So some of the very 
popular empirical approaches are used in practice which at least, 
seems to be reasonable to strike a balance between the reliability 
and the effort required in forming them. Author, in the present 
work has adopted one such approach which considers the damping 
matrix as a linear combination of mass and stiffness matrix. This 
approach is suggested by many of the famous persons in the arena 


of dynamics eg. Clough and Pengien ri73. 

So, we can write, 

Cc3 = co*IItn + ciFKl 

Putting this in equation C4.123, we get 

mm ■ « 

CM3CXD +• co*CM][X3 + C4*CK]CX3 + CKllIXl = CP3 4.13 

4.1.7 ; DECOUPLING 

Let CX3 = EMODE3CU3 4.14 


T 

where CU3 = CU* U* Ua U*3 
and 

Ui''s, i = l , 2, 3,4 are the independent 

coordinates. 

Putting equation 4.14 in equation 4.13 and premultiplying the 

T 

resulting equation by CM0DE3 , we get, 

T . . T . T . 

CMODE3CM3CMODE3CU3 + co*CMODE3CM3CMDDE3[U3 + c*«CM0DE3 CK3 TMODEl rU3 

T T 

+ CMODE3CK3CMODE3CU3 = CMODE3CP3 4.15 
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Now, 

NMii 0 0 O 

0 NM21 0 O 

0 O NM*8 O 

0 0 0 NM. 

Where, 

NMii=(Mii + rTidai*M24 + + rrtd*i*M^i) 

+ (M« + tTld21*M22 + md»4*M82 + ITld4H*M«)*ITld21 

+ <Mi 2 + md2i<t>N2s + fTidsA^iiss + md4.i«N*s)*md8i 
+ (Mi 4 + tnd2i«M24 + rridss.«Ma4 + md4i»M44.)»md4i 

NM22=(N11 + 1X^22*^121 + ITldS2*ii81 + tTld42»M4l) 

+ <Mi 2 + md22*M22 + iTid82*Ma2 + iiid42*M42.) •mdza 
+ (Mia + md 22 *li 2 a + inda 2 *Maa + fiid42*M4a)*mda2 
+ (Mi 4 + (rid22«M24 + inda2«lia4 + tTid42»li44)«nrid42 
NMaa=(Mii + mdaa^Mai + rridaa»Mai + md4a»M4i) 

+• (Mi 2 + nrid 2 a*M 22 + mdaa*Ma 2 + tnd4B*M42) •mdaa 
+ (Mia + iTidaa*M 2 a +• mdaa*Maa + md4a»M4a)*md88 
+ (Mi 4 + rrid2a*M24 + fTidaa«Ma4 + md4a*M44)*md4a 
NM44 =(Mii + fTid24*M2i + fnda4«iiai + md44*M4i) 

+ (Mi 2 + iTid24*M22 + trid84*Ma2 + ind44*M42)*nid24 

(Mia + md24*M2a + iTida4*Maa + md44*M4a) *mda4 

+ (Mi 4 + irida4*Ma4 + mda4*Ma4 + md44i^44>*md44 
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NKii 0 0 0 

„ 0 NKaa O O 

T 

C MODE KKK MODE D = ^ 

0 O NK*8 O 

- 0 O 0 m** 

NKii=(Ki 4 + frid 2 i»Kaji)+ CKia+ mdai^Kaz + mdBi*K »2 + md 4 **K* 2 ) *md 2 * 

+ (mdai^Kaa + iridsi^Km + trid*i*K*a)*mdBi 
+ (md2i»K24 + rrid84»K84 + md4i.*K44>*iTid4i 
NKaa =(K4t+ md22*Ka4)+ (Kia + md 22 «K 22 + md 82 *K 82 + rrid42*K48.)«md22 

+ (rnd 82 »K 28 + nrid 82 »K 8 a + rTid42«K48) »md88 
+ (md22*K24 + md82*K84 + jrid42*K44>%rid42 
NK8a= (K4.1+ md 28 *K 2 i)+ <Ki 2 + md 28 *K 22 + n-id 88 *K 82 + iTid4a*K42)*md28 

+ (tridBBBKBB + md8a*Kaa + ind48«K48>*md88 


+ (md28*K24 + md88*K84 + trid488K44)*md48 
NK44 =(Ki 1+ md24*K2l)+ (K 12 + md24«K22 + fTld844»K82 + md44*K42)*md24 

+ (frid24«K28 + tTid84«K88 + ind44«K4a) «md84 
+ (md84«K24 + fTld84«K84 + n'ld44*K44) *md44 


Pi + P2*md24 + P 8 *md 81 + P4*|T|d4* 

PI + P2*md22 + P8*md82 + P4*ITld42 

T 

[M0DE]*|] P ] = Pi + P8*md88 + Pa^mdsa + P4*md48 

Pi + Pa*n'id84 + P8*md84 + P4*md44 

The equations in independent co-ordinates are 

8 8 ■ 

NMii*Ui + (co^NMii + ci*Nkii)*Ui ♦ NKii*Ui 




Pi ♦ P2*md2i + P8*tndai +P4*jnd44 


4. 15 



NM22*U2 + (cO*NM 22 +• Ci*Nk22)*U2 NK22*U2 

« Pi + P 2 *ITlCl 22 + P«*md »2 +-P4«md42 4.17 

Nlia**U8 + (co^Nliaa + ci*Nkaa}*Ua -*• NKaa*Ua 

= Pi ♦ P 2 *md 28 + Pa*mda8 +P4*md48 -.4.18 

m 1 , 

NM44*U4 + (cO*NM 44 + Cl*Nk44)*U4 NK44*U4 

* Pi + P2*md24 + P8*md84 +P4»md44 4.19 

4.1.8 RESPONSE OF THE END EFFECTOR 


Now depending upon whether Zb is sinusoidal or square the above 
set of equations can be solved accordingly. Then one can go 
bark to equat ion and get the response in the joint space. As 
soon as the response in the Joint space is known, they can 
readily be converted to cartesian space to find the end effector 
response. 


One can write, 

AAA 

Rp = Ex»i + Ey*j + Ek»k 


Where, Rp is the position vector of 
with respect to the base co-ordinate frame. Ex, 

A 


the end effector 

A A 

Ey, E* and i , j , 


k are the components and the unit vectors in Xb, Yb and Zb 
directions respectively. 

If Exo, Eyo,EKO are the components corresponding to the 


equi 1 ibr ium 


configuration, it can be written as 
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Ex ~ Exo = 

[S4<»*C^»»(Sbo«C»o*C*o + S»o*C»o) - ^♦•S*o»S*o«»Sbo 
+ ^5S ^ S80*C40»CS0 + SsO*C80)> + ClO (^*4X‘S50*C40 + ^ss«S40*CsoJ 

+ Si.O*£<L 8 + L4) •088*580 + 028*L2*Sao] ,4. 20 

Ey ~ EyO — 

L»* [-ClO*{0a8(S8O*C8O*C4O + S 80 *Cso) - 044*S8O*S4O*5 sO 
+ 0S»S(S8O*C4O*CsO + SsO*C 80 ) } + SaO (044*SsO*C4O + 0SS*54O*C5o] 


- CiO*£(L8 + L4) *088*580 + 022*L2*S2o] 4.21 

E* - Ezo = 

Lo* [088(C8O*C5O - S80*S50*C40) - 044*S4O*SSO*C8O + 

0SSCC8O*C4O*CSO - 580*550 .i]] 

+ [022*L2*C2o + (La +• L4.l*088*Cao + 7»J ......... ........... 4. 22 


The above equations give the position of the end effector at any 
tinie with respect to the equilibrium conf igurat ion . 

The procedure of finding end pf factor response of a 5_D.0.F 
robot when subjected to random excitation is the saniP as 2_D.0.F 
system . Hence, to avoid c 1 urns L ness, the formulation is not shown. 
Direct expressions would be used whenever required . 


4.2 ; SIX D.O.F SYSTEM 

Ih 

If one observes the direction of rotation of the 6 joint, 
it can be noticed that there is no disturbing couple so that the 
6 link can vibrate . Hence the 6 lint- can be taken as frozen 
with the 5*’*' link. Any arbitrary amount of rotation of the 6*”^ 
joint does not change the position of the EE tip. This is because 
it is axisymmetr ic and also the last link of the robot. Hence 
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the contribution of the 6*'^ lln^• to the system KE and PE can be 
found out without much headache as they are no way functions of 

Hencey the only alteration to be made is to replace 
I by F y T ^ F y Mr by (M5 +M<s> and Lc bv 

jj jj ** sz 

(Ls+Ltf) 
where , 

F stands for frozen 

and 

zz 2 X'. 

Now getting the new mass, length and jnertia of the 5^^ linl: 
one can follow the saine approach as of 5_D.0.F system to finti tiie 
end effector response for any kind of e;:citation . 

4.3 SUMMARY 

This chapter has dealt with the response of the end effector 
of a five and six D.O.F manipulator for various type of 
excitations. The frequency equation 4,7 developed will give a 
basis of the stability of the system when perturbed fromi the 
equilibrium configuration. The modal analysis gives an idea of how 
the different modes take part in vibration. The expressions 

obtained in this chapter will be used in chapter 5 for numerical 
calculations and discussions. 



CHAPTER 5 
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NUMERICAL RESULTS AND DISCUSSIONS 

5. 1 THE INPUT PARAMETERS 

In chapter 4, the frequency equation 4.7 and the 
expressions for response Ceqn. 4. 20-4. 223 of the end-effector 
for different kind of loadings were derived. In order to perform 
numerical calculations with these equations, one must assign 
numerical values to the parameters that appear in these equations. 
These parameters are of two types - 

a> System parameters, such as mass, length, radius of the 
links, rotational stiffnesses of different joints etc. 

b> Non-system parameters, such as damping constant, joint 
angles, external loadings etc. 

System parameters are constant for a particular male of robot. 
The non-system parameters may vary depending upon the 
configuration of the structure and the environment in which it 
works. We have considered PUMA_560 as our system. The system 
parameters are chosen from ref.iI163. These are given in Table 
5. 1 and 5. 2 

Selecting values for some of the non-system parameters is not 
an easy task. If one tries to analyse the system for the actual 
condition, he has to rely on experimental data, which in many 
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are derived on the baei*-. of e.nmr simp] i f y i ng a<.<:.uiript i ort'^, 
Joint dapiping values are difficult to obtain with reasonable 
arr.uracy lierause of its dependence nn temperature, nalurl’ of 
lubr leant etc. 

The authov has aseaiineci some value ctf the daiiiping ennstant’-. 
Co = C* = 0.01 but other combination of values can be chosen. 

The external loading charai teristir*:. may depend on the 
operating environment. The study is confined to a range of 
frequencies varying between iO H7 to 300 H7 . which simulaces the 
base excitation due to a rough surface, undulations in the path of 
the moving robot, or induced due to grouruJ vibration. 


TABLF 5.1 


LINK 

MASStLg. 3 

LtMGTHtmt . ) 

RAD I US (mt. 3 

1 

12.96 


0. 17435 

2 

22.37 

0,4313 

0.02637 

3 

5.01 

0.3738? 

0,00648 

4 

1. 18 

0 . 05625 

0.0076157 

5 

0.62 

0. 05625 

0.00424 

6 

0. 16 

0.00375 

0.002828 


The rotational stiffnesses of the joints are as follows; 
K± = 3*10* N-M/RADIAN. 

K2= 1.8«10* N-M/RAUIAN. 

K8 = 1 . 0»10*N-M/RAD.XAN. 
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K 4 Ko K<s =- 500 N-M/RADIAN. 

ThH ja\n'l range of ihe different jointe. are as follows 


TABLE: 5.2 


JOINT 

JOINT RANGE! DEGREE) 

1 

-160 TO 160 

jiL 

-225 TO 45 

3 

-45 TO 225 

4 

-110 TO J70 

5 

-100 TO 100 

““ i 

6 

-266 TO 266 


5_2 EFFECT OF JOINT PARAMETER VARIATJUN ON NATURAL FITLQUENCJES 

The study of the natural frequency of any system is very 
important in respect of understanding its behavior in the 
presence of any external forcing agent . A study has been inaoe 
for a 6 _ D-O.F man ipulator to know the variation of the natural 
frequencies with respect to different parameters. These 
parameters include the Joint stiffness, masses of the links, 
geometric configuration and the load at the tip. As mass and 
joint are the constant properties of a system, they are held fixed 
whereas the configuration the load at the tip are var jerl for the 


purpose of our study. Amongst the 

different joint 

parameters , 

4pao 

is varied between “*135 to 135 at 

fixed 

values 

of ^ko, K ^ 

3. 

Within these limits the values 

of the 

joint 

paramet er s 

are 
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selected e.g. Bto- 135 , = 90*, ^o= ^o= 4xso =0*. 

The significance of this configuration is that the second link 
IS vertical and others are at horizontal position when ^»o=0 . 

With the given values of the parameters, one can observe that 
the values of the third and the fourth natural frequencies 
are so high that their variation does not carry much importance in 
our study. As for example, loa varies between 330 rad/sec to 310 
rad/sec, and <04 varies between 650 rad/sec to 600 rad/sec when 
IS varied between -135*to 135*. Hence, their study is excluded 
from the work. 

The dependence of (m on is shown in Fig. 6. It may be 

O 

observed that on starts decreasing from -135 to a minimum value 

o o 

at 91 and then from 91 onwards it starts inrreai=;ing . The second 

e 

frequency toz at first increases until it reaches a maKimum at O 

O 

and thereafter, it decreases to a rriinimum at around 118 . 

o 

It may also be observed from Fig. 6 that for <0 

O 

increases with increasing load whereas for > 0 , it decreases 

with increasing load . All the •'P=constant ' curves intersect in 
the neighborhood of = 0 . This shows very little dependence 
of iM. on 'P' at this configuration. The reason for this dual 
behavior in the two regions of is as follows. 

When is increased in the positive region, the effective 

stiffness of the system decreases with increasing load at the 
tip whereas in the negative region of ^o, the effective 
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tit if shows, a decline with more load 

I FiQure 7 w® vs ^sor the behavior of the different curves 
at constant P carries the same explanation as above. 

Let us now focus attention on the other side of coi v.s ^ 30 « It 
IS notable that with the increase in value in , the curve dips 

downward towards the axis when 4»ao .■ o". Hence , it is 

predictable that for some definite value of •'P- , b>i would contain 

zero value by touching the 4>ao axis tangentially at 4mo - 91 “= 

m 

4m « One can say ihat *tt"ns frequency branch osculates the 

axis at this point. The particular value of P and 4>»* are called 
the CRITICAL DIVEK&EMCE LOAD and OSCULATION ANGLE for the 

prescribed values of joint parameters. The significance of 

osculation is that it indicates the onset of instability in the 
system. 

5.3 : DEPENDENCE OF CRITICAL DIVERGENCE LOAD ON iao 

Next, we examine the values of the critical divergence load 

as function of the equilibrium position of tiie third linL of 

the manipulator . Given the equilibrium angles of the different 
joints, one can either solve the frequency equation 4.7 for 

P, with the condition w = 0 or by iteration method . Throughout 
this calculation the values ^ko , k s? 3 are held fixed and is 

varied between 0**and 180*^. The choice of such range for 4>ao is 
obvious in the context that for < O”, with the increase in 

load at the tip, wi does not dip downward, instead it increases. 



48 


Hence with the increase in load the system will never reach to a 
critical configuration . 

In Fig. 8, it can be observed that the critical divergence 
load decreases when varies from 0* to 91* and it 

increases when 4^o > 91 . The minimum value of the critical 
divergence load is 100 kg. and occurs at ^o=91^. It increases on 
either side of ^0=91*^. Hence for this value of 4»k> , called 

osculation angle, the structure assumes the weakest configuration 
This characteristic is in conformity with Fig. 6. The nature of such 
behavior for a 3_D.0.F system is shown by Anderson C83. 

5.4 : RESPONSE OF THE END EFFECTOR 
5.4.1 : DETERMINISTIC EXCITATION 
Ai SINUSOIDAL LOAD 

The response plots for sinusoidal loading are shown in 

figC9 - 143. The plots for each D.O.F has been taken at two 
different forcing frequencies . These are coi = 10 rad/sdc. and 

< 0 ® = 100 rad/sec. The nature of the plots at different D.O.F for 
OH and o« shows the similar trend. This result shows that at 
higher frequencies there is participation of higher modes in 
the response. 

The other distinctive part of the curves lies in the transient 

part. At higher frequency, transient part stays for longer time 

with higher amplitude. But at lower frequency, transient part 
does not have significant amplitude and dies out faster. For 

high-speed operation of robot, the analysis of response at higher 
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frequency is required so that the end effector never crosses the 
stipulated limit of positional accuracy , 
h. LOAD PULSE 

The plots of response vs. square load is given in 
fig.C15 - 203. The analysis of the end effector response is 

performed at two different values of forcing frequencies as 
earlier . Square pulse may be thought of consisting of many 
sinusoidal waves with different amplitudes and frequencies. If 
any of these frequencies matches with the system natural 

frequency, the system will undergo large oscillation . But as the 

th 

system under consideration is damped and also for the fact the n 
harmonic in the square pulse possesses (l/n)*'*’ amplitude of the 
1®'' harmonic, the system can be saved of severe damage in such 
occurrence . 

In comparison to the plots taken for sinusoidal input, the 
response is higher in this case. The steady state solution shows 
tendency to be of impulse type. This is distinctively visible for 
the lower frequency curve. The transient part is 
predominantly prevalent in the case of higher frequency . 

5.4.2 RANDOM EXCITATION 

In FIB. 21, the plot of probability and response for different 
D.O.F robot subjected to white noise excitation is shown. The 
spectral density of excitation is taken 0.0001 n*} —sec/rad. The 

upper bound of frequency is taken to be 500 rad/sec. » 
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The characteristic of each of the curves is similar i.e with 
the increase in probability the response increases. The curve is 
steep near the origin and flat as probability approaches 
unity. The trend amongst the curves is that, for higher D.O.F, for 
3 particular probability, response decreases. This trend reverses 
for 6_D.0.F. The 6 lin^ being a frozen linK, increases the 

effective length of the 5^^ linf and so the end effector amplitude 

of oscillation also increases. 

5.5: A FEW RECOMMENDATIONS ON PUMA_560 

On the basis of the observations in this chapter, one can make 
a few recommendations on PUMA_560. These are as follows 
1> There are some critical values of P at each joint configuration 
for which the natural frequency of the system may be zero. The 
system will diverge and cause failure. Hence the maximum value of 
the external load P that can be carried by the end effector in a 

particular configuration should not exceed this critical value of 

P. To be on the safe side, the maximum load at the end effector 
must not be fixed above the lowest value of the critical 
divergence load that occurs at the osculation angle. 

2 ' At higher frequencies, the system response transients are 
large. So, in order to lessen this, damping in the joints should 
be increased. This will result in the steady state oscillations 
with low amplitudes. A special focus on the complex nature of the 
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sycteiii receptancF is necessary. At high frequencies, it does not 
die out but slowly assumes an almost constant value CHqn. 3.3 3. 
This IS of serious considerat 3 on when the system has random 
excitation. If any random process consists of a wide range of 
frequency, it will cause large oscillations at the joints and 
decrease the system performance to an alarming level. In this 
case, one can either increase the joint stiffnesses or isolate the 
vibration. Isolation of vibration can be done either at the source 
or in the robot mounting platform. The increase in joint stiffness 
will increase the natural frequencies which in turn reduces the 
transmittance at higher frequencies. 

Figure 21 shows that the end effector response for a 6_D.0.F 
robot IS more than a 5_D.D.F robot for the same spectral density. 
It means that any extension of the link after the 6 link should 
be done with due consideration as it may exceed the stipulated 
limit of positional accuracy. This also conforms to the robot 
design where the linkages are usually made to be more light weight 
as WG reach near the end effector. 


11335". 



CHAPTER 6 
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CONCLUSION 


6. 1 SUMMARY OF RESULTS 

In this investigation the natural frequencies of vibration, the 
conditions of stability and the end effector response of a 
mechanical manipulator with six rigid linLs have been 

determined. The links are connected through resilient joints that 
include restoring moments. The small oscillations of the lini-s 
with respect to an arbitrary equilibrium configuration have been 
studied and the values of the critical divergence loads have been 
calculated as function of the configuration of the manipulator. 
The response of the end effector for sinusoidal, square and random 
excitation has been found out at different values of forcing 
frequencies. A comparison of response has ben made amongst 
manipulators of three different types when subjected to 
ergodic and stationary random process. Plots of « vs. reveal 

that the first natural frequency, ( m ., osculates the ^ao axis at a 
critical value of P acting at the tip of the manipulator. This 
proves to be the critical divergence load. The osculation angle 
is the angle at which the critical divergence force is a 
minimum for a given set of configurations . 
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At high frequency, when there is the participation of the 
higher modes in the response of the end effector, the transient 
response seems to be of considerable importance. Robots which are 
employed in high-speed operation, requires that the end effector 
response be dampened out in the quickest possible time. So, the 
selection of the damping parameters can accordingly be made from 
fig. 


6.2 SCOPE FOR FUTURE WORK 

The present work has the following scopes for future. 

1> Instead of cylindrical links, actual shapes of the links can be 
incorporated. 

2> Base excitation due to a variety of forcing functions for 
various makes of robots need to be investigated. 

3> There is a need for experimental determination of the joint 
damping parameter values to model the robots realistically. 

4 > Elastic deformations of the flexible arms of the light weight 
robots should also be investigated as it may contribute to the end 
effector positioning error. 

5> An ideal white noise is not practically feasible. Response 
character ist ics of robots due to random excitation having 
varying spectral densities need to be studied. 
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